package WayPoints;

import java.util.ArrayList;

import Movement.NERoom;

import lejos.robotics.navigation.WayPoint;

public class NERecorderMain8 {

	/**
	 * @param args
	 */
	public static void main(String[] args) {
		
		ArrayList<WayPoint> actualPath = new ArrayList<WayPoint>();
		ArrayList<WayPoint> destinationPath = new ArrayList<WayPoint>();
		ArrayList<WayPoint> bestPath = new ArrayList<WayPoint>();
		
		actualPath.add(new WayPoint(0, 0));
		actualPath.add(new WayPoint(0, -3));
		
		destinationPath.add(new WayPoint(0, 0));
		destinationPath.add(new WayPoint(-2, 0));
		destinationPath.add(new WayPoint(-2, -2));
		destinationPath.add(new WayPoint(0, -2));
		destinationPath.add(new WayPoint(0, -1));

		
		NERecorder NERecorderMain = new NERecorder(actualPath, destinationPath);
		
		// Verif listOfRoom
		NERoom testListofRoom;
		testListofRoom = NERecorderMain.listOfAllRooms.get(0);
		System.out.println(testListofRoom.toString());
		System.out.println(NERecorderMain.listOfAllRooms.get(1).toString());
		
		// Test calcul d'intersection
		
		System.out.println("BestPath :");
		bestPath = NERecorderMain.returnBestPath(1);
		System.out.println(bestPath.toString());
	}

}
